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Abstract 

This paper treats the positioning control problem of the endtip of space manipulators whose base are 
uncontrolled. In such a case, the conventional control method for industrial robots based on a local feedback 
at each joint is not applicable, because a solution of the joint displacements that satisfies a given position 
and orientation of the endtip is not decided uniquely. We propose a sensory feedback control scheme for 
space manipulators based on an artificial potential defined in a task-oriented coordinates. Using this scheme, 
the controller can easily determine the input torque of each joint from the data of an external sensor such 
as a visual device. Since the external sensor is mounted on the unfixed base, the manipulator must track 
the moving image of the target, in the sensor coordinates. Moreover the dynamics of the base and the 
manipulator is interactive. However, we can prove that the endtip asymptotically approaches the target 
stationary in an inertial coordinate frame by the Liapunov's method. Finally results of computer simulation 
for a 6-link space manipulator model show the effectiveness of the proposed scheme. 


1 Introduction 

For the next generation of the space activities, various missions in satellite orbits are planned. In order to carry 
out these missions, robots that replace astronauts are indispensable, because the number of astronauts living 
in the orbit is limited. In particular, many plans of robots for extra vehicle activities have been proposed such 
as shown Fig.l. They are small spacecrafts(or satellites) equipped with manipulators and visual devices, and 
are thought to perform a wide variety of tasks while flying freely around the mother ships. 

One of the differences of space manipulators from conventional ones on the ground is that their bases, namely 
spacecrafts, are unfixed. Therefore the degree-of-freedom of motion of the whole system increases by 6. When 
the endtip is positioned at a target object floating independently of the manipulator system, one may think 
that the base as well as the joints must be controlled. Of course thrusters and reaction wheels are necessary to 
translate and rotate bases themselves. Thrusters can output gas jet like on-off and reaction wheels can make 
moments by changing their angular velocities. In case that they cooperate with joint actuators to control the 
endtip of the manipulator, their capacities need to be large, or manipulators need to be operated slowly. Hence, 
it is inadequate to control the base and joints at the same time from the view point of energy, weight, or task 
efficiency. Therefore it is desirable to be able to control the endtip of manipulator only by the joint actuators, 
nevertheless the uncontrolled base is moved by the reactions from the manipulator. 

When the base is uncontrolled, the base’s motion depends on the action of joint. In such a case, the linear 
and angular momenta of the whole system floating in non-gravitational environment are conserved, because the 
joint actuators generate no external forces. Considering this constraint, the kinematic degree-of-freedom of the 
system reduces to the number of the joints. The position and orientation of the endtip, however, depend on 
the time history of joint displacements. In other words, they cannot be expressed as functions only of the joint 
displacements at each time. If one applied a conventional local feedback method to this system, one could not 
define the joint displacements corresponding to a given position and orientation of the endtip. Therefore the 
positioning control of the space manipulator needs global feedbacks using data of external sensors such as visual 
devices. 

For this problem, Vafa and Dubowsky developed the virtual manipulator concept, that is an idealized kine- 
matic chain [l]. When the base’s attitude is controlled and its position is uncontrolled, this concept is very 
useful. Alexander and Cannon showed that the endtip can be controlled by solving inverse dynamics that in- 
cludes the base’s motion [2]. However, much calculation is necessary to get the control inputs by their method. 
Umetani and Yoshida proposed the generalized Jacobian matrix, that relates the endtip velocities to joint ve- 
locities by taking the base’s motion into consideration [3], They also showed that a desired endtip velocity can 
be resolved to joint velocities by this relation. However, they treated only the kinematic problem. 
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Fig.l: Space robot Fig. 2: Model of the space manipulators 


We propose a sensory feedback control scheme that position the endtip at the target specified in an inertial 
space without using inverse dynamics. This is based on the concept of an artificial potential defined in a 
task-oriented coordinate system [4,5]. Using this scheme, the deviations of the endtip measured with external 
sensor on the base is fed back to the each joint multiplied by the transpose of the Jacobian. Since the external 
sensor is mounted on the free-motion base, the sensor signal indicates as if the target were moving. Thus the 
manipulator must track the moving target, though this target is stationary in the inertial coordinate frame in 
fact. In general, it is difficult to show the asymptotic stability of the position control system tracking a moving 
point. Fortunately it is possible to prove it by using the Liapunov’s method and the dynamical relationship of 
the motion between the base and joints. 

In this paper, first we discuss the kinematics of space manipulators, and an algorithm to derive the generalized 
Jacobian from the conventional Jacobian is shown. Next, considering the dynamics of space manipulators, we 
represent the new control scheme, and discuss its stability. Finally we show the effectiveness of the proposed 
scheme through the computer simulation. 


2 Kinematics 

In this section, we consider kinematic relation between space manipulators and their bases by using the conser- 
vation laws of linear and angular momenta of the whole system. 

2.1 Modeling 

A space manipulator system in the earth’s satellite orbit can be approximately considered to be floating in the 
non-gravitational environment. We treat this system as a set of n + 1 rigid bodies connected with n joints that 
form a tree configuration. Each joint is numbered in series of 1 to «, and these displacements sire represented 
by the joint vector q — [ £ 1 ,^ 2 ? * •* » <?» ] T * On the other hand, each body is numbered in series of 0 to n. In 
particular, we assign B to the number of the base body. The mass and inertia tensor of i-th body are rrii and 
I % respectively. 

Let us define two coordinate frames. One is the inertial coordinate frame, Ej, that in the orbit where the 
system exists; another is the base coordinate frame, E B , that is attached on the base, whose origin is located 
at the centroid of the base. In this paper, we express all vectors in terms of frame E B . The reasons why we 
introduce the base coordinate frame are to contrast the properties of space manipulators with that ground-fixed 
manipulators and to use the data measured in this frame for the control scheme later. In order to represent the 
orientation of frame E B relative to frame E /, we use three appropriate parameters such as roll, pitch, and yaw 
and their vector form representation <f> E i? 3 . 
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As shown in Fig.2, let Ri and n be position vectors pointing the centroid of the i-th body with reference 
to frames E/ and E s respectively. The relation between them can be written by 

Ri = Rb + (!) 

where Rb is the position vector pointing the centroid of the base with reference to Ej. 

Moreover, let Vi and 17; be linear and angular velocities with reference to frame E/, v, and w, be linear 
and angular velocities with reference to frame E B - They have relations as follows; 

V, = Vi + V B + n B x. r„ (2) 

n t = u>, + n B , ( 3 ) 

where V B and fi B are linear and angular velocities of the centroid of the base with reference to frame Ej , 
and operator ‘x’ represents outer product of vectors. The Jacobian matrices corresponding to the linear and 
angular velocities of the centroid of each body can be obtained as functions of the joint vector q\ 

Vi = Ju(q) q, ( 4 ) 

«*>i = JAi{q ) q ( 5 ) 


2.2 Linear and Angular Momenta of the System 

Since we treat in this paper the case in which no gravitational forces act and no actuators generating external 
forces are employed, the linear and angular momenta of the whole system are conserved. We assume here that 
the system is stationary in initial state. Thus these momenta are always zero. Using the relations given in the 
previous sub-section, we express these momenta as a linear combinations of V B i and q. 

The linear momentum, P, and angular momentum, L, of the whole system are defined by, 

P d i' (6) 

0 

L d = £{«/</* -brn^x Vi}, (7) 

1=0 

where B I % means the inertia tensor in term of the base frame, £#• Let us define the followings for the centroid 
of the whole system; 

m c d = £ £>” (8) 

.=o 

r c{q) = f rn,ri(q)/mc, ( 9 ) 

*=0 , i^B 

J c (q ) d = Y2 m i J Li{q)/ m c € R 3xn . (i°) 

*=0, »#B 

Substituting equations(l),(2), (3), (4), and (5) into equations(6) and (7) yields 


Each block is defined by 


■( 

H v 

Hvq T 

H v a \ [ 
Hn ) L 

V B \,(H Vq ' 
n B \ + \ H Uq , 

\ . r o 
) q+ [ r b *p . ' 

(ii) 

H v 

def 

mcU 3 

e R 3 * 3 , 


(12) 

Hvn 

def 

->nc[rcx] 

e R 3x3 , 


(13) 

H Vq 

def 

TTlcJc 

e R 3 * n , 


(14) 



(15) 


Ha =' 


H 


def 
Qq — 


53 { B h + miD(ri)} + I B tR 
*= 0, »^B 

n 

53 ( B /, J/i, + m,[r,x]J L ,} € R 

»=0, i^B 


3x3 


>3x« 


(16) 


where U 3 is 3 x 3 unit matrix, and two matrix functions [rx] and D(r) for a vector argument r = [ r y , r y , r z } T 
are defined as follows; 

0 “ r * . . 
r z 0 —r z 1 G R 3 * 3 


f 1 

[rx] = 


r * r v \ 

> -r. 

X o ) 


D(r) d = [rx] T [rx] € R 


3x3 


(17) 

(18) 


Since the zero linear and angular momenta are assumed, substituting P = O and L = O into equation(ll) 
and solving it for Vq and 17 #, we obtain 


V B 1 _ / 

' -^(g)-[rc(9)x]f/ B - 1 (g)H M (g) A 

n B J “ \ 

-H B -\q)H M {q) j 


where 


H B A M 
H M * 


Hn - TYicD(r c ) 

Hn q - mc[rc*]Jc 


e fl 3x3 , 

e r 3xu . 


(19) 


( 20 ) 

( 21 ) 


Matrix Hq and Hb are the inertia tensors of the whole system with respect to rotation about the centroid of 
the base, Hq, and the centroid of the whole system , Re- The inverse of inertia tensor H E always exists, because 
it is positive definite. Equation(19) is the significant and basic relation for space manipulators that represents 
how the base is translated and rotated(Va, 17 a) by the joint action(g). 

Between angular velocity of the base, 17 a, and time derivative of the orientation parameters of the base, <£, 
there is a relation 

n B = N(<f > ) </>, IV(^) G R 3x3 . (22) 

From equation(19)and(22), we can derive 


N(<t>)j>=-H B - 1 (q)H M (q ) q. 


(23) 


Since this equation is not integrated, the orientation of the base depends on the time history of the joint 
variables. Therefore the position and orientation of the endtip cannot be expressed as functions only of the 
joint variables, q. Conversely even though the position and orientation of the endtip are given, it is impossible 
to obtain the joint variables to satisfy the given conditions in the way industrial robots always do. This is the 
reason why the global control feeding back information of the endtip is required. 


2.3 Generalized Jacobian Matrix 

Applying equation (19), the linear and angular velocities, V E and 17^, can be expressed as a linear combination 
only of the joint velocities. The equations with respect to the endtip motion such as equations(2), (3), (4), and 
(5) are hold, thus substituting equations(19) into them yield 


V E = Jl(q) Q, 
He - ^a(q) Q, 


where 


Jl = Ji-Jc + [(r B -r c )x]H B - l H M e R 3 *\ 

B ~Hm 


J A = j a -h. 


-ll 


G R 


3x n 


(24) 

(25) 


(26) 

(27) 
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In eqnations(26), vector r E is the position of the endtip with respect to the base. Matrices Jl and J A are 
respectively the conventional Jacobian matrices that correspond to the linear and angular velocities relative 
to the base. On the other hand, matrices J L and J A are called the generalized Jacobian matrices. They are 
associated with the linear and angular velocities including the influence of the base motion. 

Both Ve and 17 £• what we use here are relative to tke inertial coordinate frame , £j, and they are expressed 
in terms of the base coordinate frame, Eb- This representation of velocities is unnatural, because the value of 
them cannot be directly derived from the data of the endtip measured with the sensor on the base. Using them, 
however, the generalized Jacobians, J L and J A , can be expressed as functions only of joint variable q, and 
this clarifies the differences from the conventional Jacobian. Equations(26)and(27)show that the generalized 
Jacobian is summation of the conventional one and additional terms, and the additional term depend on the 
mass and inertia tensor of the each body as well as their dimensions. If the inertia of the base is very large, 
namely m B -> oo, I B -» oo , the additional term becomes zero and the generalized Jacobian is equal to the 
conventional one, because Jc O, Tc — * O, and H B —* oo. 


3 Dynamics 

In this section, we derive the equation of motion that is required to discuss the stability of the control schemes 
proposed later by using the Lagrangian formulation. 


3.1 Kinetic Energy 

The total kinetic energy of the whole system is defined by summing up the translational energy and rotational 
energy of each body. 

T^\t\ 

1=0 

Substituting equation(28) into equations(2)and(3) yields 


, T B hn i 

+ m,V , 

T vj. 


(28) 

yields 





H v 

Hvn 

Hv q \ 

' v B ‘ 


Hv n T 

H a 


n B 

, (29) 

H Vq T 

H aq T 

H q ) 

Q . 



where matrix H q is given by 


ff/= £ {JA> TB IiJM + m i JLi T JLi} € R nx ' 

»= 0 , 


(30) 


that is the inertia matrix of the manipulator whose base is fixed [6]. 

In case that the linear and angular momenta are conserved at zero, the relevant equation (19) holds, and 
substituting it into equation(29), we obtain the reduced form 


T = ^ q T H(q ) q, (31) 

where 

H*=H q -mcJc T Jc — HM T HQ l HM € R nXn . (32) 

Using the fact that the (n 4* 6) x (n + 6) original inertia matrix in equation (29) is positive definite, it is^easy 
to prove the reduced inertia matrix, H } to be symmetric and positive definite. Moreover each entry of H is a 
function only of the joint variable, q. Therefore the equation of motion for the reduced form can be derived in 
the same way used in conventional robotics. 
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3.2 Equation of Motion 

Since there is no potential energy in non -gravitational environments, the Lagrangian is equal to the kinetic 
energy. Using the Lagrangian formulation, we can derive the equation of motion of the system 

^ a. 9 1 

Hq + Hq- — {-q T Hq} = r, (33) 

where vector r = [ 'Tl> *2, * • • , r* j 7 * is composed of the control inputs into joint actuators. 

4 Sensory Feedback Control 

In this section, a new positioning control scheme for the endtip of manipulator whose base is uncontrolled during 
manipulation. 

The problem here is to position the endtip of manipulator at a target on an object floating still in the inertial 
frame. It is assumed that the position and attitude of the base is initially arranged so that the endtip of the 
manipulator can reach the target. 

4.1 Deviation of the Endtip 

While the base is moved by the reaction force and moment from the manipulator, the position and orientation 
of the target seen from the view point on the base change. In order to represent the orientation of a certain 
coordinate frame £*, we introduce a matrix A+ that plays the role of rotational coordinate transformation from 
frame £* to £#. This matrix consists of the three unit vectors along the coordinate axes of £*, namely n*, s*, 
and a* orthogonal to each other; 

A m d = [ n* 8 + a m ] £ fl 3x3 . (34) 

Let r D and Ad be respectively the position and orientation of the target that the endtip is desired to approach, 
Ve and Ae be respectively the position and orientation of the endtip. One can easily derive them from the 
data of an external sensor such as a vision device mounted on the base. 

Now let us define position and orientation deviations, e p and e 0 , which represent the difference in position 
and orientation between the target and the endtip of the manipulator; 

*D -r E e R 3 ( 35 ) 

i(nj5 x »D + S E x b d + a E x a D ) € R 3 . ( 36 ) 

They are employed in the control scheme of the next sub-section. The orientational deviation, e 0 , is the same 
as Luh’s introduced in resolved- acceleration control [7]. 

4.2 Control Scheme 

We represent a control scheme that feeds back the above-mentioned deviations to the input torque of each joint 
r, which is given by 

r = kp T[(q) e p + k a J%(q) e„ - K v q, (37) 

where k p and k 0 are the positive scalar gains for the position and orientation respectively, and symmetric 
positive definite Ky £ R nxn is the gain matrix for joint velocities. The block diagram of this scheme is shown 
in Fig. 3 . In this scheme, the controller can determine easily the inputs torque of each joint from the deviations 
of the endtip, e p and e OJ multiplied by gains k p and k 0 and the transpose of the generalized Jacobian J i and 
Ja • Moreover the position and attitude of the base is not required to measure, because they are never used in 
the whole process of deriving the control input. 

Since the external sensor is mounted on the free-motion base, the manipulator must track the moving target 
that is actually floating stationary in inertial space. Generally it is difficult to discuss the global stability of 
the tracking system of a moving target. In our case, however, we can prove the stability because the seeming 
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Fig .4: 6 -link manipulator mounted on spacecraft 


motion of the target object depends on only the motion of joints. If the following conditions hold during the 
manipulation, 

rank ( Jj Jj ) > $, ( 38 ) 

n E T n D + a E T *d + <*e T an > -1» ( 39 ) 

the closed loop system applied this scheme is asymptotically stable. In other words, the position and oriental 
tion of the endtip converge to the target as t — ► oo. It should be noted that the condition(39) means that the 
orientation of is not diametrically directed to that of 


Proof : To represent the whole system in our case, the state variable must include of the orientation the 

base 4> as well as q and q of the joint. Then the state variable vector z is defined as; 

* [ if q T q T ] T € (40) 

The closed loop system including the control scheme is written by the differential equation 

i = F(z\ (41) 

where function jF(z) is defined by 


r G{+,q)q 

F(x) A = q € R 2 * +3 , (42) 

. H-'iq) b(<t>,q,q) _ 


G d = -AT -1 Hb 1 H m e R 3 * 3 , 


(43) 
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(44) 


b d = -H q+ -^{^q T H q}+T G R n . 


d A 


For this proof, let us introduce another orientational deviation vector; 

G R 9 . 


E* 


TId — Tl E 
&D ~ *E 
a D — &E 


W(z) = t kp e , T e p + jk a Ej E 0 + \q T H q 


(45) 


(46) 


Now we propose a function of z 

1 , T 1 

2^p € p e p + ^ ^ ~ v ' 2 

as a candidate of Liapunov function. This function is zero in the set of desired state 

£ d - { z I r E-r D} n E = n Df s E = s Dl a E = a D , q = O n }, (47) 

and is certainly positive except for the set £. In space z, set £ consists of not only an isolated point but also a 
set of connected points. 

The time derivative of function W along the solution trajectory of equation(41) is 

w = -q T I<vq < o, (48) 

that is, negative semi-definite in term of state z. To evaluate this equation, the following relations and the 
equation of the generalized Jacobian(24)and(25) are used; 


?f q { 1 -?Hq } = 1 -q T ilq, 


E a = 


e P = V E - [« B x] e p , 

[«£!X] \ 

[« E x] n E - 


[oex] 


\n B x\ o o 

O [/? B x] O 

o O [tt B x] 


E a , 


(49) 

(50) 

(51) 


If the time derivative of function W is equal to zero, q = O n , all states in the invariant set satisfy the 
following equation; 




k p e p 


e 0 

<t> = o 3 . 


= O ni 


(52) 

(53) 

Condition(38) suggests that equation(52) is equivalent to e p = O3 and e 0 = 0 3 . Furthermore if condition(39) 
is satisfied, equation e Q = O 3 is equivalent to E 0 = O9. Therefore the maximal invariant set whose entry satis- 
fies W = 0 is equal to set £ . According to the theorem of LaSalle, set £ of system(41) is asymptotically stable. □ 


If conditions(38)and(39) are not satisfied, there are some equilibrium points except for the desired state in 
set £, namely the singular points of Jacobian where the system will get stuck. However, this problem is not 
serious because the controller can make a temporary input to get the system out of the singular configuration. 

Since this scheme is not a trajectory control, the endtip cannot always approach along a line to the target. 
However, making a virtual target on the line from the current endtip to the real target, the endtip moves nearly 
on the straight line. To realize this idea, one can use the following deviations e p and e Q instead of e p and e 0 . 


def 


def | 


% 

ll e j>|| < e j 

P^IJ-epmoi 

ll e j>ll ^ e i 

e 0 

lk.ll < e < 

JIet[r e ° mo1 

IKII > e, 


pmax 


omax 

omax 


(54) 

(55) 


Positive numbers e pmax and e omax are the maximal values of the norms of the deviations. This method does 
not influence the stability of the system. 
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(a) Local feedback scheme (b) Proposed scheme 

Fig. 5: Results of the simulations (state every 3 seconds) 


5 Computer Simulation 

We verify the effectiveness of the control scheme proposed in the previous section through the computer simu- 
lation. We use a 140(kg) weight manipulator model mounted on a 2000(kg) weight spacecraft shown in Fig.4, 
that has six revolute joints. 

First a result that suggest the local feedback schemes are not suitable is shown in Fig. 5(a). In this figure, 
the endtip has a box to make its orientation clear. The endtip is positioned at a different point from the target, 
because the desired joint values are calculated on the assumption that the base is fixed. The inertia of the base 
in this model is quite large, however, the base’s motion is not negligible for the endtip control. 

Next we show a result using the proposed scheme in case that the gains and the limits of deviations are 
given as; 


k v 

ko 

K v 

Cpmax 
e omo x 


75 (N), 

100 (Nm), 

diag [400, 100, 200, 10, 2, 2] (Nmsec/rad), 
0.2 (m), 

0 . 1 . 


The state of the system is displayed every 3 seconds in Fig. 5(b). Fig. 6 represents the time responses of 
deviations ||ep|| and ||e 0 ||. When the endtip reach the target, the translational displacement of the base is x : 
0.01 (m), y : 0.07 (m), 2 : 0.04 (m) and rotational displacement of the base is roll: 16 (deg), pitch: 10 (deg), 
yaw: 1 (deg). The translational displacement is small, on the other hand, rotational one is so large that have 
a quite influence on positioning of the endtip. Using the proposed scheme, the position and orientation of the 
endtip reach the target, nevertheless the base is moved as this results. 


6 Conclusion 

For space manipulators, global control scheme that feed directly information of external sensors back to joints 
actuators is indispensable. In this paper, we proposed one method to realize them. 
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(a) Position (b) Orientation 

Fig. 6: Time responses of the norm of the endtip deviations 


Computer technologies in space are developing slowly in comparison with those on the ground due to the 
influence of radiant rays and badness of heat radiation. Therefore the simple control scheme as equation(37) 
that does not burden computers is suited to use in space. 

In this paper, we also show the method that makes up the generalized Jacobian from the conventional 
Jacobian. As shown in this process, obtaining the generalized Jacobian needs much more calculation than the 
conventional Jacobian. Moreover it needs identification of inertial parameters as well as dimensional parameters. 
To avoid these obstacles, we are examining the possibility to apply approximately the conventional Jacobians, 
Jl and J Ay in equation(37) instead of the generalized Jacobian, Jl and J A [8]. 
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